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ABSTRACT 


i 

i 

< 

In  airborne  anti-submarine  warfare  there  is  a  need  to 
more  accurately  determine  the  positions  of  sonobuoys  on  the  1 

surface  of  the  water.  This  report  develops  two  algorithms  ■ 

which  employ  extended  Kalman  filters  to  determine  estimated  . 

position.  The  bearing  from  the  aircraft  to  the  sonobuoy  is 
tne  primary  measurement.  Range  information  is  not  available.  ^ 

The  first  algorithm  is  a  six-state  filter  which  was  reduced  , 

from  the  13-state  system  developed  by  the  Orincon  Corporation. 

i 

Its  states  include  relative  position,  relative  velocity,  and 
inertial  misalignments.  The  second  algorithm  includes  two 
cascaded  Kalman  filters.  The  primary  two-state  filter 
estimates  sonobuoy  position.  A  secondary  filter  estimates 

drift  from  information  obtained  from  the  primary  filter.  | 

Both  algorithms  successfully  estimated  sonobuoy  position  for 

1 

simulated  aircraft  data.  The  effect  of  a ircraf t-to-sonobucy 

i 

range,  the  frequency  of  measurement,  and  changes  in  altitude 
are  also  analyzed. 


i 
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I.  INTRODUCTION 


The  P3  Orion  is  the  U.S.  Navy's  primary  long  range 
an ti-submarine  warfare  (ASW)  aircraft.  It  is  outfitted  with 
equipment  which  allows  it  to  search  for,  locate,  and  track 
submarines.  The  aircraft  carries  a  Univac  digital  computer, 
the  CP  901,  which  performs  much  of  the  navigational  and 
tactical  plotting  chores.  The  primary  sensor  used  ty  this 
and  many  other  A3W  aircraft  is  an  airdropped  listening 
device  known  as  a  sonobuoy.  The  Orion  generally  deploys 
several  scnobuoys  (4  to  20)  in  patterns  which  can  cover  a 
thousand  square  miles  of  ocean  while  searching  for  the 
submarine.  Once  contact  has  been  made,  these  sonobucys 
provide  information  which  locates  the  submarine.  The  target 
can  then  be  tracked  (or  attached  if  required)  until  the 
Orion's  mission  is  complete. 

The  sonobuoy  is  dropped  from  the  aircraft  at  the 
geographical  location  designated  by  the  aircrew.  Once  in 
the  water  the  sonobuoy  floats  and  deploys  a  hydrophone  to 
depths  varying  from  50  to  500  feet.  The  information  picked 
Uf  is  transmitted  back  to  the  aircraft  where  it  is  analyzed. 
This  information  can  consist  of  the  relative  intensity  of 
target  noise,  bearings  and  sometimes  ranges  to  the  target, 
ail  cf  which  are  used  to  fix  the  current  position  of  the 
submarine.  In  ^rder  to  maintain  close,  accurate  tracking  and 
be  able  to  launch  an  attack,  the  submarine's  position  must 


be  accurate  tc  within  several  hundred,  yards.  The 
information  received  from  the  sonotuoys  has  some  error 
inherent  in  the  nature  of  the  measurements  made  ty  the 
hydrophone.  Sor.obuoy  position  error  also  contributes 
signif icantly  to  the  submarine  tracking  inaccuracies. 

Historically,  the  positions  of  the  sonotuoys  were 
determined  and  updated  by  "ma  rk-on-top’’s .  This  required  the 
aircraft  to  home  on  the  transmitting  s  one  buoy  until  the  buoy 
was  overflown.  At  that  instant  the  aircraft's  position  was 
entered  into  the  on-board  computer  which  slewed  the  buoy  to 
this  updated  position.  After  many  of  these  updates  the 
computer  was  able  to  develop  a  bias  which  was  applied  to  the 
sono'cucy  positions  in  the  computer  effectively  allowing  them 
tc  drift.  The  method  had  several  disadvantages.  Hrrcr  in  the 
up aatea  position  was  at  least  as  great  as  the  aircraft 
altitude  at  the  time  of  the  "mark”  which  could  vary  from  300 
to  20,320  feet.  The  accuracy  also  depended  on  the 
consistency  of  the  several  pilots  who  might  be  making  the 
mark-on-teps  during  the  flight.  The  updating  was  not 
continuous  in  tnat  it  was  several  minutes  between 
consecutive  marks  on  one  buoy  at  best,  and  more  likely  23  to 
50  minutes.  Not  all  buoys  were  even  updated.  Furthermore, 
this  method  required  the  aircraft  to  overfly  the  submarine 
many  times  in  order  to  make  the  mark-on-tops.  This  should 
be  avoided  . 

The  purpose  of  this  thesis  was  to  investigate  some 
alternative  methods  for  accurately  fixing  the  position  of 


sonobuoys.  They  should  allow  the  aircraft  to  stand-off  from 
the  soncbucy  field  and  still  produce  more  accurate  fixing 
than  the  historical  method  provided.  The  Naval  Air 
Development  Center  ( NADC )  at  Warminster,  PA.  had  already 
partially  developed  such  a  system.  This  thesis  was 
undertaken  in  support  of  their  work  but  was  conducted 
independently.  Their  system,  the  Sonobuoy  Reference  System 
iSP.S),  was  already  installed  on  the  aircraft  and  had  the 
capability  of  measuring  the  relative  bearing  to  any 
transmitting  scnctuoy.  Additional  information  available  for 
use  included  aircraft  heading,  altitude,  and  airspeed  as 
well  as  doppler  velocity  and  drift  angle.  Also,  the 
aircraft's  Inertial  Navigational  System  (IKS)  provided 
geographical  position  although  the  Schuler  cycle  and 
inertial  drifts  could  make  this  position  several  nautical 
miles  in  error.  On  the  other  hand,  aircraf t-to-s onobucy 
range  and  sea  surface  drift  information  were  assumed  not  tc 
be  available.  An  attempt  was  made  tc  determine  sonobuoy 
position  at  ieast  relative  to  the  aircraft  with  a  less 
accurate  geographical  position  as  a  secondary  objective. 
Kalman  filtering  techniques  were  used  based  primarily  on 
measurements  of  tearing  from  the  aircraft  to  the  sonobuoy. 
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II.  FILTERS 


Kalman  filtering  is  a  recursive  technique  for  estimating 
the  state  of  a  system.  It  was  developed  in  the  1363's  by  R. 
E.  Kalman  and  improved  upon  previous  methods  by  Wiener  and 
others.  The  Wiener  filter  is  based  on  frequency  domain 
designs  which  are  statistically  optimal  but  are  only 
applicable  to  stationary  processes.  The  Kalman  filter  is 
based  on  state-space,  time  domain  formulations  and  is 
especially  suited  to  digital  computers.  From  a  simplistic, 
one-dimensional  point  of  view,  the  Kalman  filter  recursively 
averages  noisy  measurements  to  provide  a  more  precise 
estimate  of  the  actual  value. 

Assume  that  a  system  can  be  linearly  modeled  with  state 
equations  in  matrix  form  as 


X.  =  X,  , 
k  "k-l  k4 


+  =\  u  +  r  w 

k-l  k-l  k-i  k-l 


( 

\ 


1  ) 


where  X  represents  the  states  of  the  system  at  the  Kth 
k 

interval.  (Only  the  discrete  case  was  be  considered  in  this 

study.)  $  is  the  transition  matrix  and  is  used  to 
~k 

"propagate"  the  system  from  K  tc  K+l.  U  represents  the 

k 

control  input  tc  the  system  and  W  represents  white, 

guassian  noise  with  3  mean  and  Q  variance,  written  N(3,0  ). 

k  k 

Measurements  are  requirei  to  update  the  system  and  are 
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described  by  the  linear  matrix  equation 


ZK  * 


aA 


(2) 


where  Z  is  the  measurement.  H  describes  the  relationship 

K.  K. 

between  the  states  and  the  measurement  and  V,  is  measurement 

k 

noise  described  by  N(0,R  ). 

The  discrete  Kalman  filter  equations  are: 

Propagate 


X 

k 


(-) 


(  +  ) 


(2) 


? 

k 


(-) 


|i  P  (+) 

k-i  k-i 


K- 


(4) 


U ^date 


"  Pk( 


->  4  [vk<->  4  *  5„] _1 


V+)  =  xk(_)  +  Gk  [zk  ■  Hkxk(_: 


p, (  +  )  = 

k 


1  -  Vy 


*  k^  ’ 


where 


A 

X. 


=  estimate  of  the  state  X 


k 


?  =  covariance 

k 

j  =  Kalman  gain 


15; 

(6) 

(7) 
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A 

The  estimate  prior  to  the  measurement  is  denoted  by  XK(-) 
and  can  he  updated  after  the  measurement  to  a  new  estimate 
denoted  XK  This  notation  is  shewn  in  figure  1.  The 

covariance  matrix  provides  a  statistical  measure  cf  the 
uncertainty  of  X.  Consider  a  2  x  2  covariance  matrix  where 
the  error  T  in  the  estimate  is  defined  as  x  -  x  : 


- 

* 

- 

E(xJ  ) 

E(x,  Xj  ) 

z 

<*, 

a,  a2 

S(x,  x2  ) 

2(x*  ) 

a,  c2 

2 

J 

. 

- 

The  diagonal  elements  represent  the  mean  square  errors  of 
the  corresponding  state  variables  X,  and  x2 .  The 
off-diagonal  elements  are  indicators  of  cross-correlation 
between  the  states.  The  Kalman  gain  1  is  an  optimal  gain 
choosen  so  as  to  minimize  the  sum  of  the  diagonal  terms  of 
the  covariance  matrix. 


TlWt  - ► 


Figure  1.  Kalman  filter  notation 
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If  either  the  system  model  cr  the  measurement  model  is 
non-linear,  then  non-linear  filters  must  he  used.  Let  the 
non-linear  system  he  described  ty 


■  ?<**  >  *  V, 

i  W  k  N  (  2  ,  Qk  ) 

(9) 

-  h(h>  *  \ 

;  vk~N(0,Rk) 

( 1  <3 ) 

A 

where  c&(  X.  )  represents  the  non-linear  eauations  of  the 
r  k-l 

system.  They  can  be  linearized  by  a  Taylor  series  expansion 

A 

around  the  latest  estimate  of  the  state  to  obtain  fg(X.  ). 
Likewise,  h(X^)  represents  the  non-linear  measurement 

A 

equations  and  by  a  Taylor  series  expanicns  yields  H(X.  ). 


PU.  )  =  SHX.  )  -  |(X.  ) 


X.  —  X,  ... 
k  k 


a  a  r  a  i 

r* '  k  ^  —  n  ^  k  ^  T  ^  ^k^  L^k  _  ^k  !  *  *  *  * 


where 


5  V  -  77  l*<2-’ 


J  x-x 


H(X.  ,  =  f-  Fh(  X  ) 

k  3x  L  k  _ 


x-x 


(ID 


(12) 


(13) 


(  14) 


Second  craer  Taylor  series  terms  are  neglected.  Now,  the 
extended  Xalman  filter  can  be  implemented  with  the  following 
equat ions  : 
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Propagate 


V->  -  (15) 

Fk'-»  *  *<**,'-> j  -=*,;♦>  !<*!«<-> >T*  «k-.  <«) 

Update 


.(-)  H(Xk(-))T^:(Xk(-i)  Fk(-)  H(Xk(-))T 


+  Rk]  ^17) 


v*) 


xk<->  *  »k 


2k  -  ii,xk(-'ij 


(  18) 


ii  +  > 


:  -  skH(5k(-))]  pk(-, 


( 19) 


Higher  order  filters  can  be  used  if  the  linearization 
errors  are  large.  The  second  order  Xalman  filter  employs 
one  more  term  in  the  Taylor  series  expansion  by  mcdifing  the 
update  equations  of  the  extended  Kalman  filter  to  account 
for  this  term.  The  iterated  extended  Kalman  filter  uses  the 
same  equations  as  does  the  extended  Kalman  filter.  However, 
the  calculations  are  repeated,  each  time  linearizing  about 
the  most  recent  estimate,  until  there  is  little  further 
improvement  with  each  new  iteration.  The  iterated  extended 
filter  can  greatly  reduce  the  errors  due  to  ncn-1 inearities , 
mere  so  than  the  second  order  filter. 

Kalman  filters  should  be  based  on  correctly  modeled 
systems  ana  accurate  noise  statistics  to  ensure  proper 


performance.  This  is  not  always  possible  either  due  to 
ignorance  about  the  system  or  lack  cf  sufficient  statistical 
information.  A  filter  which  is  not  operating  properly  may 
diverge.  Apparent  divergence  describes  that  situation  where 
the  true  estimation  errors  are  larger  than  the  filter 
predicted  errors  although  they  are  bounded.  True  divergence 
is  characterized  by  errors  which  continue  to  grow  with  time 
and  eventually  become  infinite.  These  divergence  phenomenon 
are  depicted  in  figure  2. 

There  are  several  ways  to  overcome  the  divergence 
problem  when  the  modeling  is  not  completely  accurate  such  as 
adding  fictitious  noise.  This  allows  the  filter  a  little 
more  freedom  to  adjust  to  whatever  modeling  inconsistencies 
may  exist,  but  makes  the  filter  estimate  appear  more 
erratic.  Another  method  which  helps  overcome  divergence  is 
finite  memory  filtering.  Since  Kalman  gains  tend  to  grow 
smaller  and  smaller  as  time  passes,  they  may  reach  a  point 


(a)  Apparent  Divergence  (b)  True  Divergence 


Figure  2.  Divergence 
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where  new  measuremen t  information  has  no  effect  on  the 
estimates.  Jinite  memory  filtering  effectively  eliminates 
old  data  which  is  cc  longer  useful  by  keeping  the  gains 
significant.  This  is  sometimes  called  a  "moving  window". 

Some  simplifing  techniques  used  in  Kalman  filters 
include  precomputed  gains.  Although  forfeiting  the  optimal 
Kalman  gains,  this  has  the  advantage  of  reducing 
computational  burden.  More  importantly,  the  gains  can  be 
controlled  to  overcome  modeling  weaknesses  if  necessary. 
Another  technique  which  can  be  used  when  more  than  one 
measurement  is  provided  to  a  filter  is  processing  them  one 
at  a  time.  This  avoids  taking  the  inverse  of  more  than  a 
scalar  when  computing  the  updated  covariance  matrix  ?K(+;. 
This  is  possible  if  the  simultaneous  measurements  are 
considered  to  be  ta*cen  sequentially  over  a  zero  time  span. 
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III.  MODELS 


A.  GENERAL  APPROACHES  TO  SYSTEM  MODELING 

The  aircraf t-sonobuoy  system  must  he  modeled  in 
state-space  for  use  with  the  Kalman  filter.  There  are  at 
least  two  approaches  to  the  modeling  of  this  problem 
depending  on  the  point  of  view.  One  intuitive  approach  is  to 
assume  the  sonohuoy  drifts  at  a  constant  velocity  and  then 
use  aircraf t-to-sonohuoy  tearing  measurements  to  locate  the 
sonohuoy.  The  states  become  sonohuoy  position  and  sonohuoy 
velocity.  Unfortunately,  this  problem  is  not  observable. 

The  bearing  measurements  provide  only  information  about 
position;  there  is  no  rate  of  change  information  in  the 
bearings  themselves.  In  addition,  the  aircraft  must 
maintain  a  track  of  its  geographical  position  between 
updates  in  order  to  determine  the  next  expected  measurement 
for  the  Kalman  filter.  As  mentioned  before,  this  aircraft 
position  is  subject  to  non-linear  as  well  as  linear 
navigational  drifts  which  are  not  taken  into  account  in  this 
model.  However,  an  observable  system  can  be  obtained  by 
reducing  the  number  of  states  to  sonohuoy  position  only  and 
Introducing  fictitious  process  noise  to  account  for  the 
drift.  This  noise  effectively  allows  sonohuoy  position  to 
update  so  as  to  keep  up  with  the  drift.  One  approach 
developed  by  this  thesis  is  a  variation  of  this  concept. 


20 


Another  approach  considers  only  the  relative  position  of 
the  sonobuoy  with  respect  to  the  aircraft.  Relative 
velocities  and  relative  accelerations  must  be  taken  into 
account  and  these  change  radically  as  the  aircraft  flies  in 
the  tactical  situation.  Sonobuoy  position  is  net  obtained 
directly.  (When  only  the  word  "position"  is  used  it  will 
indicate  the  position  relative  to  an  earth  fixed  coordinate 
system,  such  as  latitude  and  longitude.  "Relative  position 
will  always  mean  the  location  with  respect  to  an  aircraft 
fixed  coordinate  system.) 

There  are  some  other  considerations  which  should  be 
addressed.  The  sonobuoy  drift  is  generally  slow  (less  than 
5  NP./Hr  most  of  the  time)  and  constant.  It  is  not 
unreasonable  to  assume  that  the  entire  sonobuoy  field  drifts 
at  the  same  velocity.  Another  point  is  that  aircraft 
navigational  drift  can  not  be  distinguished  from  sonobuoy 
drift.  In  other  words,  the  drift  that  is  preceived  by  the 
aircraft  is  the  combination  of  sonobuoy  drift  and  aircraft 
navigational  drift.  If  this  navigational  drift  is  linear 
and  not  excessive  it  causes  few  problems,  however, 
non-linear  navigational  drifts,  such  as  the  Schuler  cycle, 
can  cause  large  errors. 
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B.  THE  COORDINATE  SYSTEM 

A  r ight-handed  coordinate  system  was  chosen  as  depicted 
in  figures  3  and  4.  This  is  a  departure  from  the  work;  of 
Orinccn  Corporation  which  is  described  in  the  next  section. 
This  system  allows  all  angles  to  he  measured  positive  in  the 
direction  they  are  normally  defined,  i.e.,  aircraft  heading 
measured  clockwise  from  north.  It  also  coincides  with  the 
usual  aerodynamic  coordinate  system. 


figure  3.  Earth  fixed 


*  Aircraft  heading, 


clockwise 


Nose 


Aircraft  pitch,  +  up 
Aircraft  roll,  +  r.  wing  down 
Doppler  drift  angle,  +  r.  dri 
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C.  'THE  SIX-STATE  SYSTEM 


Orincon  Corporation  of  La  Jolla,  CA.,  completed  a 
technical  report  in  December  of  1976  concerning  the  Sonobuoy 
Reference  System.  They  were  contracted  by  NADC  to 
investigate  the  effect  of  errors  in  the  aircraft 
navigational  system  on  the  performance  of  the  sonobucy 
tracking  procedure.  As  a  result  of  their  worif  they 
developed  a  13-state  mathematical  model  which  successfully 
determined  sonobuoy  positions  in  spite  of  these  navigational 
errors.  The  complete  state  vector  was 


1L  = 


AX,  Ax  av,  AV, 


m .  n. 


(22) 


where 


Ax  =  relative  position  of  the  sonobuoy  from  the  aircraft 
Av  =  relative  velocity  of  the  sonobuoy  from  the  aircraft 
x  =  position  of  the  sonobuoy  on  the  ocean  surface; 
v  =  velocity  of  the  sonobuoy  on  the  ocean  surface! 

’p  =  inertial  system's  platform  azimuth  alignment  errors 
m  =  inertial  system's  gyro  drift  rates  assumed  constant 


(Subscripts  1,  2,  and  3  represent  North,  East,  and  down 
respectively.)  The  model  was  developed  using  state  equations 
which  described  sonobuoy  motion  relative  to  the  aircraft  and 
relative  to  the  ocean's  surface.  These  were  derived  by 


Qrinccn  from 


AX  =  X  -  (X1  +  E) 
a 


(21 ) 


and  other  mechanization  equations  to  obtain 


All 

=  A*, 

A  *2 

=  AV2 

A  Vi 

=  -R  i  +  w  (  X  i 

-  i'i  -  aij) 

~  $>2^2 

-  i>2g 

A  v2 

=  -R2  u)2  (  *2 

-  -  ‘*2  1 

-  1^3a1 

~  = 

(22) 

where 

X1  =  aircraft  inertial  navigation  system  position 
a 

S  =  aircraft  inertial  navigation  system  error 
R  =  vector  from  the  center  of  the  earth  to  the  aircraft 
g  =  acceleration  due  to  gravity  (assumed  constant) 
a)  =  Schuler  frequency  -y/g/R ' 

A  =  aircraft  accelerometer  outputs 

The  scnocuoys  were  assumed  to  drift  at  a  constant  velocity 
and  the  aircraft  was  assumed  to  fly  at  a  constant  altitude. 
The  inertial  alignment  errors  were  described  by 
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ronia  ho  ntpri  a s  a  deterministic  control  innut 


=  \p2n  sinx  -  ^Qcosx  +  rrL 
*i>2  =  -t1fl  sinx  +  m2  (23) 

=  -vp 3q  cosx 

whe  re 

n  =  earth  rate 
X  =  latitude 

There  were  several  sources  of  measurement  information. 
Aircraft  to  sc no buoy  bearing  was  available  from  the  aircraft 
interferometer  system  in  the  form  of  cos9  where  9  is  the 
angle  between  the  direction  tc  the  scncbuoy  and  the  base 
line  cf  the  antenna.  Doppler  velocity  and  drift  angle  from 
the  aircraft  doppler  radar  system  provided  information  about 
Av ^  and  Av  2 .  The  only  other  relevant  source  cf  measurement 
information  would  have  come  from  dFS  (Dlobal  Positioning 
System)  which  would  have  provided  error  free  aircraft 
position. 

Orincon  performed  a  numerical  observability  analysis  or 
this  system  based  on  the  observability  matrix  M ^  given  by 

i-1 

If  this  matrix  is  positive  definite  for  N  s.  2  then  the  system 
is  considered  observable.  In  addition,  an  eigenvalue 
analysis  provided  information  as  tc  the  conditioning  cf  the 
The  result  of  their  analys is  indicated  that  the 
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system. 


system  was  not  fully  observable  with  measurements  from  the 
interferometer  and  dopplf  systems  alone.  Only  ten  states 
were  observable;  soncbuoy  position  most  likely  was  not 
observable  and  \j>3,  m  m2,  v1  and  v2  were  weakly  observable 
at  test.  They  also  noted  that  "observability  is  reduced 
when  the  aircraft  pursues  a  straight  flight  path".  By 
removing  sonobuoy  positions  and  gyro  drifts  from  the  system 
they  found  the  observability  improved.  Further,  the  system 
became  fully  observable  if  sonobuoy  velocity  was  also 
removed  from  the  state  vector. 

The  Orincon  report  presented  the  results  of  a 
Monte-Carlo  simulation  on  the  13-state  system.  However, 
they  concluded  that  a  reduced  state  filter  made  up  of 


XT  = 


AXj  4*2  Av2  4>l  ip2 


(25) 


would  provide  a  workable  solution  to  the  problem  although 
they  noted  that  it  had  a  tendency  toward  divergence.  It  was 
partly  the  intention  of  this  report  to  further  the 
investigation  of  this  reduced  state  filter. 
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The  state  equations  for  the  reduced  six-state  filter  can 


be  obtained  directly  from  Equations  (22)  and  (23). 
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-  Ax2)  -  li>jg 


0 

0 

~g 

0 


AX 


Ax, 


AT 


AT, 


0 

0 

-R1+  cu^-X^) 

-R2+  to(  x^  — 1  a2  ^ 
0 
0 


which  can  be  abreTiated 


A  A  '  A** 


X  +  B 


(27) 


Expressed  in  discrete  time  the  s-tate  -equation  is 


krt 


Xk  +  Ak  +  “k 


(28) 
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The  discrete  formulation  of  the  plant  matrix  can  be  obtained 
from 


i  ‘<T‘{l51  -  A|'}  * 


:"H  _  gAt 


Developing  this 
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the  system  is 

si  - 

A 

=  (s2 

+  2x2 

+  UJ  / 

(s2 

+  n2s in 

2x)2 

(29) 


(30) 


(31) 


The  inverse  of  this  matrix  and  its  Laplace  transform  are 
presented  on  the  following  pages  as  Equations  (32)  and  (33) 
respectively. 
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-g  flsinX 


flsinA 


sin<i>t-8in(0sinX)t  -g  coswt-cos(flsinX)t 


sin(fisinX)t  cos(OsinX)t 


The  discrete  formulation  of  the  continuous  matrix  3  is 


f  At 

=  \  e  dX  B  where  X  =  At  -  x  (34) 

Hence 

{-77-  +  (x,  -  x1.)}  (1  -  coswAt) 

+  (x2  -  x*2)}  (1  _  coswAt) 

+  w(x ,  -  x1,)}  sinojAt 

(Jk.  +  u(x  -  x1  )}  sinuAt 
ui  2  a2 

0 
0 

The  noise  term  is  Wfc~  N(0,Q).  The  variances  are  estimated 
to  be  .01  NM  for  relative  position,  1.2  (NM/Hr)  for  relative 
velocity,  and  .001  radians  for  inertial  misalignments.  As  a 
result,  the  following  constant  diagonal  matrix  is  used  for 

.01 

.01  0 
1  .0 

1.0 

0  .001 

.001 

The  same  measurement  information  is  available  as  before 
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in  the  larger  system,  namely  interferometer  bearings  and 
doppler  velocity  and  drift  angle.  These  introduce  non- 
linearities  and  must  be  modeled  as  in  Equation  (10). 


zk  =  h(Xk>  *  Vt 


A  Taylor  series  expansion  as  in  Equation  (11)  about  the 
latest  estimate  of  sonobuoy  position  provides  a  method  of 
linearization.  As  a  result 


3  Z  3  z 

3  z 

3  z 

3  z 

3  z 
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3  Ax^  3  Ax2 
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3  Av 

3  Av2 
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.  3*1 
X*A 

.  5  *2 

J 

To  determine  z  and  its  partial  derivatives,  recall  that 


i  ^  =  cos9  =  A?  •  KIT 


where  ~Kt  is  the  unit  vector  representation  of  a  line  from 
the  aircraft  to  the  sonobuoy  and  RB  is  the  unit  vector 
describing  the  base  line  between  the  antenna  pairs  of  the 
interferometer. 


=  cos  9 


.  A  /N  .  /V 

Ax.  Ax,  Ax, 
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Ax  I  I  Ax  I  I  Ax  I 


Ax1RB1  +  Ax2RB2  +  h  RB3 
(Axx2  +  Ax22  +  h2)^ 


where  h  is  the  aircraft  altitude. 
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(41) 


(42) 


The  doppler  velocity,  VJf  is  a  measurement  cf  aircraft 

a 

speed  relative  to  the  ocean  surface  and  doppler  drift  angle, 
8,  is  a  measure  of  the  angle  between  aircraft  track  and 
aircraft  heading.  These  measurements  can  be  related  to  the 
state  vector  by  assuming  the  sonobuoys  drift  at  the  same 
velocity  as  the  ocean  surface.  If  this  is  true  then 


z2  *  Vd  *  (Avl  +  A7l)h 


Expanding  in  a  Taylor  series  yields 
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The  measurement  noise,  V^,  is  described  by  N(0,R).  It 
is  assumed  that  the  measurement  noise  R  and  the  plant  noise 
Q  are  white,  gaussian,  and  uncorrelated.  Based  on 
information  obtained  from  NALC ,  R  was  assigned  the  following 
values : 

R  =  .000?  rad  (interferometer) 

R2  =  1.0  (NM/Er)  (doppler  velocity)  (55) 

R3  =  .01  deg  (doppler  drift  angle) 

It  should  be  pointed  out  that  the  doppler  measurements 
are  not  always  available.  The  doppler  system  freezes  the 
last  value  of  groundspeed  and  drift  angle  anytime  the 
doppler  radar  is  not  receiving  good  information.  This 
happens  whenever  the  aircraft  is  above  5000'  altitude,  or 
can  happen  when  flying  above  a  cloud  cover  or  when  the  sea 
surface  is  too  smooth.  As  a  result,  the  doppler  could  be 
inaccurate  during  a  significant  portion  of  the  flight. 

The  six-state  system  was  programmed  and  tested  for 
several  conditions.  Flow  charts  for  significant  portions  of 
the  program  and  the  entire  program  listing  are  presented  in 
Appendix  A.  The  main  program  has  two  purposes:  first,  to 
control  the  simulation;  and  second,  to  read  and  prepare 
measurement  data  for  the  subroutine  FILTER.  This  subroutine 
performs  all  the  Salman  filter  computations  as  specified  in 
the  above  equations.  The  Carlson  square  root  technique  is 
used  to  ensure  a  positive  definite  covariance  matrix.  Also, 
in  order  to  avoid  inverting  a  matrix  in  the  calculations  for 
the  Salman  gain,  the  three  measurements  are  processed  one  at 
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a  tine.  The  results  of  the  simulation  are  presented  in 
section  IV. 3. 
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D.  THE  TWO-STATE  SYSTEM 

An  attempt  was  made  earlier  on  in  this  research  tc  model 
sonobuoy  motion  as 


ter  I 


-  X.  - 


U,  At 
k 


k+l 


=  U. 


(56) 


with  a  state  vector  made  up  of  x  ,  x2,  u  ^ ,  and  u2.  This 
system  proved  to  be  unobservable  although  the  simple 
approach  was  appealing.  Since  sonobuoy  drift  rates  are 
generally  slow,  another  attempt  was  made  to  model  the  system 
without  velocity.  The  equations  reduced  to 


X 


k+l 


(57) 


With  only  x^  and  as  states,  this  system  was  observable. 

3y  describing  large  statistical  values  of  system  noise  there 
would  hopefully  be  enough  freedom  in  the  "update"  tc 
compensate  for  any  sonobuoy  drifts.  Unfortunately,  this 
approach  was  not  completely  successful!  however,  it  was 
observed  that  the  general  direction  of  sonobuoy  drift  was 
correct.  As  a  result  of  these  investigations  a  technique  of 
cascading  Kalman  filters  was  used  to  solve  the  tracking 
problem.  The  intent  was  to  use  results  from  one  filter  as 
measurement  for  a  second  filter.  Then,  the  result  of  the 
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second  filter  could  be  used  as  a  deterministic  control  input 
to  better  propagate  the  first  filter. 


Two  Kalman  filters  are  used  in  this  approach.  Figure  5 
shows  hew  they  are  related  (or  cascaded).  The  first  filter 
models  sonebuoy  position  and  is  based  on  the  discrete  state 
equation 


=  X,  +  U,  At  +  V, 
k  k  k 


(58) 


The  state  vector  consists  of  the  sonobuoy  positions,  and 
x2 .  Uk  is  a  deterministic  input  accounting  for  sonebuoy 
drift  and  W  is  system  noise.  The  interferometer 
measurement,  cose,  is  used  to  update  this  filter. 


Figure  5.  Cascaded  Kalman  filters. 
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The  second  filter  models  the  sorobucy  drift  with  the  state 
equat ion 


As  the  sonobuoy's  position  changes  with  each  update  of  the 
position  filter,  the  velocity  required  to  move  from  to 
in  the  time  interval  At  can  be  calculated.  This  value  is 
used  as  a  measurement  for  the  drift  filter.  Ail  scncbuoys 
contribute  to  this  filter  which  produces  one  overall 
estimate  of  drift  for  the  sonobuoy  field.  This  value  is 
then  used  as  an  input  to  the  position  filter  when  the  next 
interferometer  measurement  occurs. 

The  technique  is  understandably  sensitive  to  the  output 
of  the  drift  filter.  If  the  estimated  drift  is  too  much  in 
error,  the  estimated  positions  will  be  affected.  Divergence 
could  result.  For  this  reason,  a  simplified  Kalmar,  filter 
is  used  to  estimate  the  drift.  It  is  of  the  form 


kwi 


(6  3 ) 


The  gain  is  precomputed  from  l/(n+l)  where  n  is  the  total 
number  of  measurements  and  is  limited  to  a  value  at  least  as 
great  as  &t/(e4  min.;.  This  limit  is  reached  after  the 
first  =4  minutes  of  tracking  time.  From  that  point  on  the 
gain  regains  constant  effectively  averaging  the  drift  over 
one  period  of  the  Schuler  cycle.  It  must  be  understood  that 
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the  drift  this  filter  estimates  consists  not  only  of 
sonotuoy  drift  but  aircraft  drift  as  well  and  is,  in  fact, 
the  vector  sum  of  these.  Ar.  estimate  which  attempts  to 
follow  the  changing  velocitits  through  the  Schuler  cycle 
tends  to  cause  the  position  filters  to  diverge.  This  might 
be  the  case  if  larger  values  of  gain  are  used,  averaging 
only  the  last  few  measurements  of  drift.  Therefore,  many 
measurements  of  drift  are  averaged  which  provides  an 
estimate  for  linear  drift  only.  The  lower  limit  of  gain 
prevents  new  drift  measurements  from  being  ignored  and  also 
provides  for  flexibility  in  estimating  the  drift. 

Unlike  the  six-state  system,  the  interferometer 
measurement  is  the  only  measurement  required  by  the  position 
filter.  The  measurement  equation  is  essentially  the  same  as 
in  the  preceeding  section  where  z  is  determined  as  shown  in 
equation  (39).  Since  there  is  only  one  term  in  z,  the  H 
matrix  is  a  row  vector  consisting  of  ,  ' 


where  the  terms  are  given  in  equations  (41)  and  (42).  It  is 
necessary  to  determine  the  ai rcraf t-to-sonobuoy  range  for 
these  values  from 


where  X  is  the  estimated  soncbucy  position.  X1  represents 
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the  aircraft  position  and  is  considered  deterministic. 
Undoubtedly,  X*  is  in  error  due  to  aircraft  navigati oral 
drifts  and  therefore  causes  errors  in  the  estimated 
geographical  position  of  the  s on o buoy.  But,  since  the 
measurement  of  bearing  is  based  on  relative  positions,  the 
estimate  is  relatively  correct. 

An  observability  analysis  on  the  2-state  position  filter 
was  performed  again  using 

\  -  Z  ^  Ek  6'‘Kk  K  (63> 

k»l 

Subtitution  into  this  formula  with  N=2  yields 
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This  matrix  is  positive  definite  for  all  except  the  case 
when 


This  occurs  whenever  the  relative  bearing  from  the  aircraft 
to  the  sonobuoy  is  not  changing  (i.e.  when  flying  directly 
toward  or  away  from  the  sonobuoy).  This  is  intuitively 
correct  since  two  or  more  bearings  must  cross  in  order  to 
determine  a  position. 

The  two-state  system  was  programmed  and  tested  to 
determine  the  usefulness  of  this  simplified  filter.  The 
majority  of  the  program  is  the  same  as  the  one  used  for  the 
six-state  system.  The  significant  differences  occur  in 
subroutine  FILTER.  The  Carlson  square  root  technique  is 
used  again  but  only  one  measurement  instead  of  three  is 
processed.  The  drift  filter  is  programmed  in  this 
subroutine  along  with  the  position  filter.  A  flow  chart  and 
program  listing  are  ^resented  in  Appendix  A. 
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IV.  A.NAYLSIS 


A.  THE  SIMULATION 

Actual  data  from  the  Orion  was  not  easily  obtainable  for 
this  research.  Consequently,  a  computer  program  had  to  be 
written  to  generate  the  information  required  by  these 
algorithms.  A  flow  chart  in  Appendix  3  describes  the 
program.  An  aircraft  track  was  created  by  alternating  lines 
and  curves  of  various  lengths  and  then  a  determination  of 
noise  free  measurements  was  made  as  the  track  was  flown. 
(Measurement  noise  was  added  later  during  the  simulations.) 
Sono buoys  were  allowed  to  drift  at  a  constant  velocity,  and 
the  aircraft's  navigational  drift  was  modeled  with  a 
constant  velocity  and  Schuler  cycle  variations  as 

X1  =  X  +  X  At  *  A  sinwt  (66) 

a  a  x  x 

where 

Xr  =  aircraft  inertial  position 

a 

Xa  =  aircraft  true  position 
oj  =  Schuler  frequency  y'g/R  ’ 

The  constant  drift  rate,  was  found  by  NADC  to  have  3 

mean  and  a  standard  deviation  of  2.5  NM/rlit.  Likewise,  the 
amplitude  of  the  Schuler  cycle,  A  ,  had  3  mean  and  a 
standard  deviation  of  .5  NM.  The  effect  of  wind  was  also 
available  in  the  program  tut  was  never  included  fcr  analysis. 
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It  was  obvious  that  both  algorithms  were  extremely 
sensitive  to  the  aircraft  flight  path.  Since  there  is  no 
"typical"  flight  path  for  an  Orion  during  its  on-station 
period,  several  uniform  patterns  were  selected  vhich  would 
provide  meaningful  information  on  each  algorithm's 
performance.  These  base  parameters  were  chosen: 
airspeed  180  kts 

altitude  3000  ft 

range  15  NM  ai rcraf t-to-s onobuoy 

frequency  20  sec  between  measurements  on  one  sonobucy 

A  circular  pattern  was  flown  around  a  sonobuoy  at  a  range  of 
about  15  NK .  Initial  sonobuoy  placement  was  at  (l,l)lwith 
the  aircraft  flying  clockwise  starting  at  (15,0).  This  is 
shewn  in  Figure  €  which  depicts  a  portion  of  the  aircraft's 
true  track.  Sonobuoy  drift  was  west  at  1  NM/HR;  aircraft 
navigational  drift  was  south  at  1  NM/HR  and  included  a 
Schuler  cycle  (amplitude  .5  NM)  when  specified.  (This  drift 
would  be  indicated  in  Figures  12  thru  30  by  the  following 
notation:  DR=(a/c  180-1  +  Schuler,  b  270-1)  .)  The  sonobuoy 
remained  near  the  center  of  the  pattern  allowing  the  range 
to  remain  relatively  constant.  This  was  desirable  since 
this  basic  flight  path  was  used  to  test  the  response  of  the 
algorithms  to  variations  in  altitude  and  range.  Similarly, 
a  square  pattern  was  flown  counter-clockwise  around  a 

^  x,  ,Xj  )  measured  in  nautical  miles  from  an  arbitrary 
origin  near  the  aircraft's  starting  *,oint. 
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sonctuoy  at  a  range  of  15  NM.  In  this  case  the  aircraft 
began  on-tcp  the  initial  position  of  the  sonobuoy  at  (-2,-3) 
and  preceeded  to  fly  the  track  shov.n  in  .Figure  7.  The 
soncbucy  was  allowed  to  drift  to  the  east  at  2  NM/ER  and  the 
aircraft's  navigational  system  to  the  north  at  2.5  NM/HR. 
This  pattern  was  used  eventually  to  analyze  performance  at 
different  measuring  frequencies.  Figure  6  shows  the  output 
of  the  aircraft's  navigational  system  when  it  has  a 
northerly  drift  of  2.5  NM/HR  while  the  aircraft  is  flying 
the  square  pattern.  Figure  &  shows  this  same  pattern  when  a 
Schuler  cycle  with  an  amplitude  of  .5  NM  is  also  present. 


^5 


E-W  POSITION  (NM) 

Figure  6.  Aircraft  track  for  the  IS  NM  circular  pattern 
with  initial  sonobuoy  location  and  direction  of  drift  indicated 
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Figure  7.  Aircraft  track  for  the  15  NM  square  pattern 

with  initial  sonobuoy  location  and  direction  of  drift  indicated 


POSITION  (NM) 


Figure  8.  Aircraft's  navigational  output  for  the  15  NM 
square;  navigational  drift  is  2.5  NM/Hr  to  the  north. 
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These  patterns  were  used  to  generate  the  data  which 
included  sonobuoy  number,  time  of  measurement  and 
measurement,  aircraft  latitude  and  longitude,  altitude, 
heading,  pitch  angle,  roll  angle,  N-S  acceleration,  S-* 
acceleration,  and  the  antenna  used  for  the  measurement. 
Also  determined,  but  used  only  for  error  analysis,  were 
sonobuoy  position  and  true  aircraft  position.  This 
information  was  computed  for  the  entire  simulation  period 
and  stored  in  a  file  to  be  used  when  needed . 

Initial  estimates  of  the  state  and  the  square  root  of 
the  covariance  matrices  were  obtained  as  follows: 

Six-state 


X\2)  = 


x(0)-x  (0) 

5. 

'  at 

Xt(0)-Xa z(2)+.5 

w  • 

-Vf  cosH 

w  m 

S  (  2  )  = 

-V^  sinn 

D 

5. 

0 

.2025 

2 

.  0025 

{ 67 ) 


Two-s  tate 


X  (0) 

Alt 

X(0)  = 

1 

S  (0)  = 

x2  (  0  )  + .  5 

D 

A1 1 

(66  ' 


where  3^(0)  indicates  the  diagonal  elements  of  S (2). 
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for  the  circular  pattern 


xL(0)  =  1. 

X  (0) 

31 

=  15. 

x2U)  =  1. 

x  (  0  ) 
a2 

=  0. 

and  for  the  square  pattern 

xL(0 )  =  -3. 

x  (0) 
al 

=  -3. 

x  2  ( 0  )  =  -3. 

X  (0  ) 

a2 

=  -3. 

The  initial  values  of  the  covariance  were  chosen  so  as  to 
describe  the  errors  in  the  state  associated  with  dropping  a 
sonobucy  from  an  aircraft.  The  two-state  system  operated 
tetter  with  a  lower  initial  variance  than  did  the  six-state 
system . 

Simulations  were  run  for  a  nominal  period  of  two  hours. 
Each  unit  of  data  was  sequentially  read  into  the  simulation 
program  from  the  storage  file.  Measurement  noise  was  added 
with  the  following  normal  distributions: 

ccsq  N(0,.0U0?)  in  radians 

doppler  velocity  N(0,1.0)  in  NM/ER 

doppler  drift  angle  N(0,.01)  in  degrees 

These  values  agree  with  the  ones  chosen  for  R  as  described 
previously.  A  random  number  generator  using  an  initial  seed 
was  used  to  create  the  noise  from  the  proper  distributions. 
After  the  estimate  was  made,  errors  were  measured  and 
manipulated  in  subroutine  RESULT.  This  cycle  was  repeated 


n 
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until  the  simulation  was  complete.  (Refer  again  to  Appendix 
A  for  a  flow  diagram  of  the  simulation  process.) 


Information  was  gathered  and  is  presented  primarily  in 
two  ways.  First,  for  both  the  square  and  circular  patterns 
the  results  of  the  first  run  of  the  simulation  are  plotted. 
(Figure  13  is  an  example.)  The  top  portion  of  the  results 
shows  the  estimated  positions  of  the  sonobuoy  on  the 
aircraft's  navigational  plot.  It  should  be  noted  that  these 
are  not  true  positions  since  inertial  errors  may  be  causing 
this  plot  to  drift.  The  bottom  portion  shows  the 
North-South  and  Fast-West  errors  in  the  estimated  positions. 
These  errors  are  the  differences  between  the  true  and  the 
estimated  relative  positions  of  the  sonobuoy .  They  are 
depicted  in  Figure  12  and  were  computed  from 


AX  =  AX,  -  AX,  (63) 

k  k  k 

AX  =  (X  -  X1),  -  (X  -  X  ),  (?2) 

k  a  k  a  k 


where  AXfc  is  the  relative  error  at  time  k .  The  true  aircraft 


Figure  12.  The  effect  of  the  aircraft  navigational  plot 
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position  is  denoted  by  X  and  the  true  geographical  position 
of  the  sonobuoy  is  denoted  by  X.  These  values  are  known 

A 

from  the  simulated  data.  X  is  the  filter's  estimate  of 

position  and  X*  is  a  deterministic  input  from  the  aircraft's 

navigational  system.  The  errors  indicated  in  these  plots 

are  different  from  those  perceived  in  the  upper  plot 

whenever  the  aircraft's  navigational  picture  is  drifting. 

The  positive  and  negative  values  of  the  square  root  of  the 

covariance  are  also  shown  on  these  plots  as  solid  lines. 

Specifically , 

N-S  error  =  ±  y7?  ‘ 

E-W  error  =  ±  -/?  ' 

22 

(Only  position  errors  are  analyzed  in  this  report.) 

The  second  way  in  which  the  information  was  gathered 
consisted  of  a  shortened  Monte-Carlo  simulation.  For  each 
scer.erio  under  study,  20  two-hour  simulations  were  run,  each 
with  new  values  of  measurement  noise  provided  by  the  random 
number  generator  from  their  respective  distributions.  The 
objective  was  to  compare  the  RMS  errors  predicted  by  the 
covariance  matrix  in  the  filters  to  the  actual  RMS  errors 
observed  in  the.#  s  imulations .  Three  RMS  statistics  were 
collected  and  plotted  versus  time  as  follows: 

1.  The  square  root  of  the  covariance  computed  by  the 
halm an  filter  is  represented  by  a  solid  line  on  the 
plots.  It  was  computed  from 
.  - 1 

o  •J—Y  ?  ,  n=20 ,  k  =  1,2,3...  (71) 

fk  '  n  ‘ — ‘22 
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This  standard  deviation  is  the  filter's  estimate  of 
its  accuracy. 

2.  The  mean  and  standard  deviation  of  the  error  in  the 
estimated  sonobucy  position  relative  to  the  aircraft 
was  determined  by 


uk  ‘ 


a 


2 


n 

£S>V  "  * 20>  k  = 

i  =  1  ' 

n 

^k,!-  uk  *  n  =  20,  k  *  1,2,3. . . 


(72) 


(72) 


This  standard  deviation  is  represented  by  an  'X'  on 
the  plot  and  is  a  measure  of  the  variability  in  the 
filter's  estimated  position. 

2.  The  Ri*!S  value  of  the  actual  relative  error  was  also 
also  determined.  It  was  computed  as 


n 

O2  =  -  V  AX.2,  ,  C  =  20,  k  =  1,2,2...  (74) 

dL ,  IX  *  ■  *  1 

k  i-1 

and  is  represented  by  an  '0'  on  the  plot.  This  value 
is  a  measure  of  the  error  which  occurred  between  the 
actual  relative  position  of  the  sonobuoy  and  the 
estimated  one.  (See  Figure  11.) 

These  values  are  plotted  over  the  two  hour  simulation  period 
(<t  =  1,2,2...)  and  provide  a  measure  of  the  accuracy 
obtained  by  each  of  the  algorithms. 
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B.  THE  RESULTS 


Orincon  Corporation  performed  mu^h  of  their  analysis 
using  the  small  circular  pattern  shown  in  Figure  12.  The 
aircraft  sped  around  this  track  at  3£S  knots  taking  a 
measurement  every  20  seconds.  Altitude  was  constant  at  3 000 
feet.  The  initial  position  of  the  sonobuoy  was  at  (2,2)  and 
it  drifted  on  a  heading  of  045  degrees  at  5.5  NM/HR  while 
the  aircraft's  navigational  system  drifted  in  the  opposite 
direction  at  5.2  NM/ER.  A  Schuler  cycle  was  also 
superimposed  on  this  drift. 

The  initial  estimates  of  sonobuoy  position  and  variances 
used  by  the  algorithms  were  different  for  this  particular 
pattern  in  order  to  coincide  with  the  Orincon  simulation  as 
much  as  possible.  They  were 
Twc-s  tate 
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0 
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SD(0) 


2. 
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Six-state 
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Vfi  -  2.8  M/S 


Figure  12.  Orincon's  simulation  flight  path. 
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Initially,  both  the  six-state  and  the  two-state 
algorithms  were  tested  using  this  flight  path  and 
comparisons  were  made  with  the  results  of  Orincon's  13-state 
system.  It  was  discovered  that  the  six-state  system's 
results  did  not  change  as  a  consequence  of  whether  or  not  a 
Schuler  cycle  existed  in  the  navigational  system. 

Therefore,  the  six-state  system  was  run  only  with  the 
Schuler  cycle  active.  The  two-state  system  was  run  with  and 
without  a  Schuler  cycle. 

The  results  of  the  first  run  of  the  simulation  are  shown 
in  Figures  13,  14,  and  15 .  The  sawtooth  shape  of  the 
covariance  (solid  lines)  is  the  result  of  the  circular 
pattern  and  is  caused  in  two  ways.  Primarily,  since  the 
sonobuoy  remains  closer  to  one  side  of  the  circle,  there  is 
a  minimum  value  of  the  variance  each  time  the  aircraft 
passes  on  this  side.  A  second  reason  for  a  change  in 
variance  is  the  aircraft's  location  in  the  pattern. 

However,  these  modulations  are  cot  as  apparent  since  the 
range  variation  dominates.  HMS  errors  were  obtained  by 
repeating  these  runs  22  times  and  are  shown  in  Figures  16 
thru  IE.  The  fluctuations  generated  by  the  flight  path  are 
apparent,  mere  so  in  the  six-state  system  than  in  the 
twe-state  system.  Also,  steady  state  values  cf  the  error 
gradually  increase.  This  is  true  because  the  average  range 
to  the  sonobuoy  increases  as  the  buoy  moves  farther  away 
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from  the  center  of  the  pattern.  (It  will  he  demonstrated 
later  that  the  errors  are  range  dependent.)  The  covariance 
of  the  six-state  system  increases  from  422  yards  at  25 
minutes  to  800  yards  at  the  end  of  the  simulation.  The 
two-state  system  increases  slowly  from  250  yards  until  it  is 
hankered  by  the  Schuler  cycle.  It  is  worthy  of  note  that 
without  the  navigational  errors  stemming  from  the  Schuler 
cycle  the  RMS  errors  of  the  two-state  system  are 
considerably  lover  than  those  of  the  six-state  system. 

Table  1  compares  the  RMS  errors  of  these  two  systems  to 
the  results  obtained  by  Orincon  for  their  13-state  system. 
(The  values  for  the  two-state  and  six-state  systems  are 
taken  from  the  covariance  at  a  point  35  minutes  into  the 
simulation.)  The  first  line  considers  measurements  of 
bearing,  do^pler  velocity,  and  drift  angle.  Navigational 
errors  are  present  including  a  Schuler  cycle.  As  expected 
there  is  an  increase  in  relative  position  error  because  of 
the  reduction  from  13  to  6  states.  The  next  line  considers 
the  effect  of  the  Jlooal  Positioning  System  (CPS),  with  very 
accurate  aircraft  positioning  information,  on  the  relative 


Schuler 

SRS-dv+DA 


No  Schuler 
SAo+DV+DA+'SPS 


13-s  ta  te 


394 


6-s  ta te 


452 


452 


2-s  ta  te 


£00 


Table  1.  Comparison  of  RMS  results  in  yards. 
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position  errors  of  the  sonobuoy.  In  the  13-state  system 
Orincon  observed  that  the  errors  in  the  states  pertaining  to 
the  aircraft  inertials  improved  markedly?  relative  position 
errors  most  lively  remained  the  same.  This  is  exactly  what 
was  found  in  the  analysis  of  the  six-state  system:  that  the 
relative  position  errors  were  unaffected  by  navigational 
errors.  However,  the  two-state  system  is  very  much  affected 
by  navigational  errors.  Relative  position  errors  were 
significantly  less  for  the  two-state  system  when  accurate 
ai rc raf t  positions  were  known . 

To  obtain  a  more  realistic  analysis  of  their  performance, 
each  algorithm  was  tested  using  the  circular  and  square 
flight  patterns  of  Figures  6  and  7.  The  results  of  the 
first  simulation  run  for  the  circular  path  at  a  range  cf  15 
NM  are  shown  in  Figures  IS  thru  21.  In  this  case,  the  wavy 
nature  of  the  covariance  is  due  to  the  location  of  the 
aircraft  in  the  pattern  since  the  range  to  the  sonotuoy 
remains  relatively  constant.  For  instance,  as  the  aircraft 
passes  directly  north  or  south  of  the  sonobuoy  the  ability 
to  correct  S-w  errors  is  greatest.  Therefore,  the  E-tf 
variance  reaches  a  minimum  value  at  this  time.  The  N-S 
variance  is  affected  in  a  similar  manner.  The  two-state 
filter  is  not  as  sensitive  to  this  as  the  six-state  filter. 
Also,  the  effect  of  the  Schuler  cycle  on  the  two-state 
filter  can  be  seen  in  Figure  22. 

The  RMS  errors  are  shown  in  Figures  22  thru  24.  The 
steady  state  RMS  value  of  error  predicted  by  the  filter  is 
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425  yards  for  the  two-state  and  750  yards  for  the  six-state 
system.  The  actual  RMS  error  in  the  relative  position  of 
the  sonobuoy  is  250  to  1200  yards  for  the  two-state  and  400 
yards  for  the  six-state  system.  Without  Schuxer  cycle  error 
the  twc-state  system  drops  to  a  steady  250  yards,  better 
than  the  six-state  system.  It  is  interesting  to  note  that 
the  measured  errors  are  significantly  less  than  those 
predicted  by  the  filter.  Both  measured  values  of  RMS  error, 
a  and  a  ,  are  in  close  agreement;  that  is,  the  deviation  of 

X  3. 

the  filter's  estimated  position  about  its  mean  is  generally 
the  same  as  the  deviation  of  the  estimated  position  about 
the  actual  relative  position  of  the  sonobuoy.  The  closer 
these  values  are  to  one  another,  the  more  confidence  can  be 
placed  in  the  analysis.  The  only  exception  to  this  is 
figure  23  which  shows  the  reaction  of  the  two-state  filter 
to  the  Schuler  cycle.  One  complete  cycle  with  a  period  of 
84  minutes  is  obvious.  The  Kalman  filter  does  not  recognize 
this  cycle  since  the  modeling  equations  do  not  account  for 
it.  The  dip  in  the  center  of  the  two  peaks  is  once  again 
the  result  of  flight  path  geometry.  The  aircraft  is  in  such 
a  position  relative  to  the  sonobuoy  that  the  measurements 
provide  enough  information  to  correct  for  Schuler  cycle 
errors.  Hcwever,  it  is  not  in  this  position  long  enough  to 
influence  the  errors  anymore  than  it  does. 

The  same  analysis  was  performed  using  the  square 
pattern  of  Figure  7.  This  scenerio  has  more  drift  than  the 
other  and  in  a  different  direction  providing  the  algorithms 
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with  another  motion  to  track.  The  outcome  vas  generally  the 
same  as  can  he  seen  in  Figures  25  thru  33.  There  is  no 
measurable  difference  in  the  results  from  the  two  different 
flight  paths.  Flying  a  straight  path  does  not  adversely 
affect  the  results  as  was  concluded  by  the  Oricon 
Corporation  for  their  13-state  system.  The  wavy  nature  of 
the  covariance  is  again  a  result  of  the  flight  path.  It  is 
not  as  smooth  as  before  because  a  square  pattern  was  flown 
instead  of  a  circular  one.  Another  look  at  errors  caused  in 
the  two-state  system  by  the  Schuler  cycle  can  be  seen  in 
Figure  30.  The  algorithm  does  make  some  corrections  to 
these  errors  but  they  are  not  as  effective  as  before.  In 
this  case  the  time  the  aircraft  was  in  a  position  to  make 
the  corrections  did  not  coincide  with  the  time  the  peak 
errors  occurred.  There  appears  to  be  no  way  to  predict  the 
optimum  time  and  place  for  the  aircaft  to  be  without  knowing 
wnen  and  how  the  Schuler  cycle  is  occurring. 

The  distance  the  aircraft  is  from  the  sonobuoy  is 
directly  related  to  the  accuracy  the  algorithms  can  achieve. 
Simulations  were  performed  at  ranges  of  5,  15,  33,  and  45 
nautical  miles  using  a  circular  flight  path  with  the 
sonobuoy  in  the  center.  (The  RMS  plots  can  be  found  in 
Appendix  C.)  The  steady  state  errors  were  observed  and  are 
plotted  in  Figure  31.  Solid  lines  represent  the  RMS  values 
of  the  covariance  and  dashed  lines  represent  the  actual 
errors.  In  all  cases  the  errors  increase  with  distance 
which  is  intuitively  satisfying.  Mathematically,  the 
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covariance  increases  because  the  H  matrix  becomes  smaller 
with  an  increase  in  range.  Consequently,  the  updated  value 
of  the  covariance,  P(  +  ),  is  lar5er  from  Equation  (19).  For 
the  six-state  system  there  is  an  increase  in  actual  error 
from  240  yards  at  5  NM  to  750  yards  at  45  NM.  And  for  the 
two-state  system,  actual  errors  increase  from  130  yards  at  5 
NM  to  500  yards  at  45  NM.  (Note  that  for  the  two-state 
system,  Schuler  cycle  errors,  indicated  by  circles,  peak 
approximately  1000  yards  above  these  plotted  values;  the 
lower  values,  indicated  by  x's,  were  used  since  they  were 
more  reliable  for  comparison  between  ranges.)  There  is  a 
slight  decrease  in  the  slopes  of  all  the  error  curves  as 
distance  increases.  Hovever,  this  decrease  is  small  and  the 
curves  might  well  have  been  interpeted  as  linear  within  the 
limits  of  the  analysis. 

The  frequency  at  which  measurements  are  made  also 
affects  the  accuracy  of  the  estimate.  Each  algorithm  was 
tested  with  measurement  intervals  of  4,  10,  20,  and  30 
seconds  cn  one  sonobuoy.  The  outcomes  of  the  steady  state 
RMS  errors  are  plotted  in  Figure  32.  (Once  again  the 
two-state  system's  errors  do  not  show  the  effect  of  the 
Schuler  cycle.)  The  actual  errors  in  the  six-state  system 
increase  steadily  as  the  measurement  interval  increases. 
However,  the  covariance  decreases  rapidly  at  first  to  a 
minimum  value  somewhere  around  10  seconds  and  then  increases 
with  increasing  interval.  An  abbreviated  run  with  a  two 
second  measurement  interval  confirmed  these  results. 
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Figure  33.  Factors  which  influence  the  covariance. 


Figure  33  helps  to  explain  this  outcome.  There  are  two 
conditions  which  affect  the  covariance.  The  most  obvious  is 
the  increase  in  covariance  due  to  an  increase  in  the 
propagation  interval.  This  occurs  because  the  plant  matrix, 
which  is  a  function  of  time,  affects  the  covariance  in 
Equation  (16).  The  second  condition  is  a  consequence  of  the 
model's  observability.  If  the  relative  bearing  between  the 
aircraft  and  the  sonotuoy  does  not  change  then  the  state  is 
net  observable.  In  other  words,  two  successive  bearings 
must  intersect  to  determine  an  estimated  position.  3y 
allowing  the  interval  between  measurements  to  become  too 
small,  the  aircraft  is  unable  to  make  a  significant  change 
relative  to  the  sonobuoy.  The  covariance  increases  as  the 
conditions  approach  those  which  make  the  problem 
unobservable.  There  appears  to  be  an  optimum  frequency  with 
which  to  make  measurements  on  one  buoy,  namely  10  seconds 
for  this  range  of  15  NM  and  speed  of  180  knots. 
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The  twc-state  system  exhibited  similar  characteristics 
in  Figure  32.  In  this  case  the  covariance  never  does 
increase  in  the  range  of  intervals  studied.  The  actual 
errors  remain  constant.  Since  the  plant  matrix  for  this 
system  is  equal  to  the  identity  matrix  and  the  Q  matrix  is 
prescribed  to  be  constant,  the  propagation  interval,  ^t, 
does  not  effect  the  covariance.  However,  the  effects  of  the 
observability  conditions  do  cause  the  covariance  to  increase 
when  At  becomes  too  small.  It  is  believed  that  as  At 
becomes  smaller  the  actual  errors  would  begin  to  increase 
also. 

The  statistical  plots  for  the  range  tests  found  in 
Appendix  3  show  that  the  Schuler  cycle  causes  larger  peaks 
in  the  actual  error  as  the  range  from  the  sonobuoy 
increases.  However,  the  peaks  are  decreasing  with  time. 
Further  simulation  revealed  that  the  peak  errors  decrease  to 
a  steady  value  about  10J0  yards  greater  than  non-Schuler 
cycle  errors.  This  coincides  with  the  amplitude  of  the 
Schuler  cycle  as  it  was  programmed  for  this  particular 
flight  path.  Therefore,  in  the  steady  state  a  Schuler  cycle 
may  cause  additional  estimation  errors  approximately  equal 
to  its  amplitude. 

Altitude  was  also  tested  for  any  effect  it  might  have  cn 
these  algorithms.  Using  the  circular  pattern  at  a  range  of 
15  NM ,  altitudes  of  300,  3000,  10,000,  and  20,000  feet  were 
tested.  Neither  the  six-state  nor  the  two-state  system 
shoved  any  effect  for  these  changes  in  altitude. 


It  is 


believed  that  at  very  small  ranges  (less  than  tvo  nautical 
miles)  altitude  might  hamper  good  position  estimation. 
However,  for  the  majority  of  the  time  altitude  is  of  no 
concern . 
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Figure  16.  RMS  position  errors  for  the  six-state  system  while  flying  the  circular 
pattern  developed  by  Orincon  Corp.  DR=(a/c  225-5.2  +  Schuler,  b  045-5.5),  At=20s, 
Alt=3000' . 
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Figure  17.  RMS  position  errors  for  the  two-state  system  while  flying  the  circular 
pattern  developed  by  Orincon  Corp.  DR=(a/c  225-5.2  +  Schuler,  b  045-5.5),  At“20s, 
Alt=3000\ 


OFl  1*2)  -tHHOH  ITUS:E  HI  OLlIXIl  ERIIOH  llUb: 


OLID  -  FILTER:  SORT  P1+P2) 


Figure  22.  RMS  position  errors  for  the  six-state  system  while  flying  a  15  NM  circular 
pattern  around  the  sonobuoy.  DR=a/c  180-1  +  Schuler,  b  270-1),  At=20s,  Alt=3000' . 
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Figure  23.  RMS  posi 
pattern  around  the  a 
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4.  RMS  position  errors  for  the  two-state  system  while  flying  a  15  NM  circular 
around  the  sonobuoy.  DR=(a/c  180-1  +  No  Sch.,  b  270-1),  t=20s,  Alt=3000' . 


PObi ! ION  (NM) 


OLID  -  FILTER:  SORT 


(SOju  ycyy3  Nomsod  swy 


82 


Figure  29.  RMS  position  errors  for  the  two-state  system  while  flying  a  15  NM  square 
pattern  around  the  sonobuoy.  DR=(a/c  00-2.5  +  Schuler,  b  090-2),  At=20s,  Alt»3000'. 
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Figure  30.  RMS  position  errors  for  the  two-state  system  while  flying  a  15  NM  square 
pattern  around  the  sonobuoy.  DR(a/c  000-2.5  +  No  Sch.,  b  090-2),  At=20s,  Alt=3000'. 
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SIX-STATE  SYSTEM 
TWO-STATE  SYSTEM 
SORT (COVARIANCE! 
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MEASUREMENT  INTERVAL  -  ONE  SONOBUOT  (SEC) 


V.  CONCULSION 


The  following  are  the  conculsions  reached  at  the  end  of 

this  research: 

1.  The  six-state  algorithm  developed  in  this  report 
produced  estimates  of  relative  sonobuoy  position  with  a 
standard  deviation  in  the  error  of  500  yards  at  a  range 
of  20  NM.  Aircraft  drift,  which  included  the  Schuler 
cycle,  had  no  effect  on  this  system  since  the  states 
were  defined  relative  to  the  aircraft. 

2.  The  two-state  algorithm  developed  in  this  report 
produced  estimates  of  relative  sonobuoy  position  with  a 
standard  deviation  of  300  yards  plus  an  amount  equal  to 
the  amplitude  of  the  Schuler  cycle  error  at  a  range  of 
20  NM.  When  no  Schuler  cycle  navigational  errors  were 
present,  the  two-state  system  out-performed  the 
six-state  system. 

3.  Both  algorithms  shoved  an  increase  in  steady  state  RMS 
error  with  an  increase  in  range. 

4.  The  sii-state  system  shewed  ar.  increase  in  actual 
steady  state  RMS  error  for  an  increase  in  the  time 
interval  between  measurements*  however,  the  covariance 
of  this  system  indicated  minimum  error  occurred  with  a 
10  second  interval  on  one  sonobuoy  at  a  range  of  15  NM 
and  an  aircraft  speed  of  180  Kts.  (This  translates  to  a 
l1-*  degree  change  in  relative  bearing.)  The  two-state 
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system  showed  no  change  in  the  actual  steady  state  RMS 
error  for  intervals  between  4  and  30  seconds  and  only  a 
slight  increase  in  these  errors  as  a  60  second  interval 
was  a pproached .  The  covariance  cf  the  system  actually 
decreased  with  increasing  interval. 

5.  Neither  system  showed  any  dependence  on  altitudes 
within  the  operational  limits  at  a  range  of  15  NM. 

6.  No  adverse  effect  was  observed  while  flying  straight 
tracks  as  opposed  to  curved  ones. 

7.  Steady  state  RMS  error  was  affected  by  two  conditions 
as  measurement  intervals  changed.  The  longer  the 
interval  the  more  the  error  tended  to  increase, 
especially  for  the  six-state  algorithm,  as  a  result  of 
system  propagation.  The  shorter  the  interval  the  more 
the  error  tended  to  increase  as  the  systems  encroached 
upon  their  non-observability  condition.  An  optimum 
measurement  interval  existed  for  each  system  which  was  a 
function  of  range. 
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VI.  SUMMARY 


Both  the  six-state  and  the  two-state  algorithms  were 
atle  to  successfully  track:  the  sonobuoy.  However,  the 
six-state  system  was  the  best  choice  given  the  navigational 
system  in  use  by  the  Orion.  It  was  capable  of  providing 
estimated  sonobuoy  positions  at  a  range  of  20  NM  such  that 
the  errors  had  a  standard  deviation  of  500  yards.  The 
computer  time  required  to  process  one  measurement  was  on  the 
order  of  200  milliseconds.  On  the  other  hand,  the  much 
simpler  two-state  system  required  only  28  milliseconds  or 
one  seventh  (j)  the  amount  of  computer  time.  However,  its 
estimate  of  sonobuoy  position  was  degraded  by  Schuler  cycle 
errors  in  the  navigational  system.  Without  these,  this 
system  was  subject  to  errors  having  a  standard  deviation  of 
300  yards  at  a  range  of  20  NM.  The  Schuler  cycle 
periodically  increased  these  errors  by  an  amount  equal  to 
its  amplitude. 

The  algorithms  were  very  much  affected  by  the  aircraft's 
flight  path  including  the  relative  location  of  the  sonobuoy, 
the  range  to  the  sonobuoy,  and  the  amount  of  angular  change 
in  the  bearing  to  the  sonobuoy  as  measurements  were  taicen. 
Since  the  sonobuoy  position  was  to  be  estimated  in 
two-dimensions,  the  aircraft  was  required  to  maneuver  in 
such  a  way  so  as  to  provide  information  in  both  dimensions. 
For  example,  as  the  aircraft  crossed  north  or  south  of  the 
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sonobuoy  the  E-W  errors  decreased  while  the  N-S  errors 
increased.  The  trend  reversed  when  the  aircraft  flew  east 
or  west  of  the  sonobuoy.  It  was  also  observed  that  steady 
state  RMS  errors  grew  with  range  at  a  slightly  decreasing 
rate.  They  were  twice  as  large  at  45  NM  as  they  were  at  15 
NM.  Finally,  the  sonobuoy  position  was  not  observable  if 
the  relative  bearing  to  the  sonobuoy  did  not  change  implying 
that  two  lines  of  bearing  must  cross  in  order  to  obtain  an 
estimated  position.  If  the  amount  of  angular  change  between 
each  measurement  was  too  small  it  began  to  affect  the  errors 
because  this  condition  was  being  approached.  Anytime  the 
aircraft  flew  in  such  a  way  as  to  reduce  the  rate  of  bearing 
change,  or  the  frequency  at  which  measurements  were  made  was 
too  high,  this  condition  was  prevalent.  It  was  observed 
that  at  least  lh  degrees  of  change  was  required  to  avoid 
this  problem. 

The  sii-state  system  showed  no  tendency  toward 
divergence  as  long  as  initial  conditions  were  reasonable. 

The  two-state  system,  on  the  other  hand,  did  have  a  tendency 
to  diverge  when  the  gains  on  the  drift  filter  were  not 
adjusted  correctly.  For  example,  if  the  gain  was  to  high 
the  estimated  drift  was  heavily  dependent  on  the  last  few 
measurements  and  was  too  quickly  affected  by  changes  in  the 
position  filter.  But,  it  was  also  necessary  for  the  drift 
filter  to  have  non-zero  gains  in  the  steady  state  in  order 
to  provide  some  insurance  against  an  initially  wrong 
estimate  of  sonobuoy  drift.  With  these  modifications  made 
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the  algorithm  operated  correctly  during  all  tests  and,  in 
fact,  had  less  error  in  some  cases  than  did  the  six~state 
system . 

It  is  the  opinion  of  the  author  that  either  one  of  these 
algorithms  is  an  improvement  on  the  historical  method  of 
"marsing-on-top  the  sonobuoy.  Further,  it  adds  a  great 
deal  mere  uncertainty  as  to  exactly  how  much  accuracy  could 
he  obtained  in  the  old  way.  Non-linear  navigational  effects 
were  not  even  considered  and  the  number  of  measurements  made 
to  determine  sonobuoy  position  was  on  the  order  of  10  or 
less  for  any  one  sonobuoy  pattern.  Nevertheless,  in  an 
operational  sense  the  accuracies  achieved  here  would  need  to 
be  improved.  Without  the  non-linear  navigational  errors  the 
accuracies  could  have  been  much  better,  however,  *he 
results  of  this  research  do  provide  another  perspective  for 

the  problem  at  hand. 
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APPENDIX  A 

THE  COMPUTER  PROGRAMS 


MAIN 


*  Required  for  six-3 tate 

Figure  3^  •  Flow  chart i  system  only, 

main  program 


92 


SUBROUTINE  FILTER 
SIX -STATE 


Figure  35*  Flow  chart:  Subroutine  FILTER 
six-state 


subroutine  filter 
TWO -STATE 


Figure  36.  Flow  chart;  Subroutine 
FILTER  two-state 

94 


GLOSSARY  OF  COMPUTER  VARIABLES 


A 

ALPHA  I 

ALT 

ANGLE 

ANT 

AVEL 

AS 

B 

BOUT 

C 

CA 
C  A 
CEL 


n 

u 


CELT 

DELX1 

DELX2 

DELX2 

DRIFT 

DSZED 

DT IME 

DZ 

EDELX1 


SIMULATION  PROGRAM 


Vector  of  aircraft  accelerations 
1 


Result  of 


~ T 

f 1  f  +  R 


or  I 
a 


Altitude 

Direction  of  sonobuoy  drift  from  North 
Antenna 

Initial  aircraft  velocity 

T 

Matrix  result  of  I  - 


a 

T 

Matrix  result  of  {  eSST  +  Q> 

Sonobuoy  R?  channel  or  number 
Gain  of  drift  filter 
Result  of  at/{84  min.) 

Constant  matrix  in  six-state  system's  equations 

Rate  of  change  of  nautical  miles  for  a  change  in 
degrees  of  longitude 

Array  which  holds  all  items  requiring  storage  from 
one  measurement  to  the  next 

Interval  between  measurements,  At 

Relative  position,  ax: 

Relative  position,  ax2 

Relative  position,  ax  3 

Magnitude  of  sonobuoy  drift  in  yards 

Seed  for  the  random  number  generator 

Array  of  initial  drop  times  for  the  sonobuoy 

Residual,  dz 

Error  in  the  est.  relative  position  of  sonobuoy,  Axr 
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EDELX2  Error  in  the  est.  relative  position  of  sonobuoy,  ^z 2 
E05S0  Matrix  result  of  e  JTSTS  2 

EPSLN  Age  weighting  factor, 

ESST  Matrix  result  of  e  S  ST 

EXl  Error  in  est.  geographical  position  of  sonobuoy, aXj 

£X2  Error  in  est.  geographical  position  of  sonobuoy,  Ax- 

F  f  vector  from  Carlson  square  root  technique 

FFT  Matrix  result  of  ffT 

f  f  T 

EFTA  Matrix  result  of  — 

FT  Transpose  of  f 

G  Gain  matrix 

GAMMA  Aircraft  pitch  angle,  y 
GDZ  Vector  result  of  G  dz 

GR  Gamma  in  radians 

E  Aircraft  heading 

K  The  H  matrix  when  used  in  subroutine  FILTER 

HOUR  Time  in  hours 

HR  Heading  in  radians 

HT  Transpose  of  the  K  matrix 

1  Index 

I  Identity  matrix  when  used  in  subroutine  FILTER 

IEND  Indicator  of  EOF 

T 

IFFTA  Matrix  result  of  I  -  ~— 

IN  File  from  which  data  is  read 

INRES  File  from  which  true  sonobuoy  positions  are  read 

IOUT  Device  on  which  print  is  made 

IOUTF  File  in  which  results  are  written 
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IOUTZ  File  in  which  random  vectors  are  inspected 
IRUN  Index  for  run  number 

IZ  Index  for  measurement,  z  =  1,2,3 

K  Incremental  measure  of  time 

LAT  Latitude 

LATI  The  latitude  of  the  origin  of  the  local  earth  fixed 

coordinate  system 

LONG  Longitude 

LONGI  The  longitude  of  the  origin  of  the  local  earth  fixed 
coordinate  system 

MARK  Indicates  whether  information  is  to  be  stored 
or  retrieved 

MEAN1  Mean  estimated  scnobuoy  position,  m 

MEANS  Mean  estimated  sonobuoy  position,  u  .-» 

MIN  Time  in  minutes 

N  Total  number  of  measurements  made  on  all  sonobuoys 

N  Index  when  used  in  subroutines  IN  ITAL  and  DATA 

NRUNS  Integer  equivalent  of  RUNS 

0  Plant  matrix,  $ 

OS  Matrix  result  of  §  S 

OST  Transpose  of  $  ST 

OSSO  Matrix  result  of  $TSTS  $ 

OX  Matrix  result  of  $  X 

P  Covariance  matrix 

PHI  Aircraft  roll  angle, 

PI  IT 

PR  Phi  in  radians 

Q  l/ariance  of  plant  noise  from  N(0,Q) 

A  Variance  of  measurement  ncise  from  N(3,R) 
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RAD  tt  /180 

RANGE  Range  to  soncbuoy  from  aircraft 

RANGE2  Squared  value  of  range 

RBI  Unit  vector  component  of  antenna  baseline 

RB2  Unit  vector  component  of  antenna  baseline 

RE3  Unit  vector  component  of  antenna  baseline 

RBX  Result  of  (RBj  aXj  +  R3 2a*2  +  RB3ai3^ 

RNO  Normally  distributed  random  number  from  N(£,l) 

RUNS  Number  of  simulation  runs  to  be  made 

S  A*.ray  in  Carlson's  square  root  technique  which 

represents  square  root  of  covariance  matrix 

51  Square  root  of  variance,  /Pn 

52  Square  root  of  variance,  ^¥22 

SEC  Time  in  seconds 

SF  Matrix  result  of  S  f 

SIGMA  RMS  error  in  the  estimate  about  the  actual  location 

SIGMAF  RMS  value  from  the  Kalman  filter,  /Pj  2 2 

SIGVAX  RMS  error  in  the  estimate  about  the  mean  estimate 

5KL  Rate  of  change  of  nautical  miles  for  a  change  in 
degrees  of  latitude 

SNEXT  Propagated  matrix  of  S 

SST  Matrix  result  of  S  ST 


sr 

Transpose 

of  S 

matrix 

SUMPl 

Array 

for 

the 

sum  of 

P(  1 ,1 )  over 

NRUNS 

SUMP2 

Array 

for 

the 

sum  of 

P(2,2)  over 

NRUNS 

SUMSQ1 

Array 

for 

sum 

Of  AX* 

over  NRUNS 

SUMSQ2 

Array 

for 

sum 

Of  AX* 

over  NRUNS 

SUMX1 

Array 

for 

sum 

of  AX 

over  NRUNS 
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SUMX2 

Array  for  sum  of  AX2  over  NKUNS 

T 

Last  time  in  seconds  the  sonobuoy  was  proces 
the  filter 

sed  Dy 

TIME 

Time  from  aircraft  clock  in  seconds 

U 

Sonobuoy  drift  vector 

U1 

Old  value  of  U ( 1 ) 

U2 

Old  value  of  U(2) 

VAR1 

Variance  of  the  estimated  sonobuoy  position 
the  actual  location 

about 

VAR  2 

Variance  of  the  estimated  sonobuoy  position 
the  actual  location  a$ 

about 

VARXl 

Variance  of  the  estimated  sonobuoy  position 
the  mean  estimated  position, 

about 

VARX2 

Variance  of  the  estimated  sonobuoy  position 
the  mean  estimated  position,  a*2 

about 

VELCT 

Relative  velocity,  aV 

VELCT2 

Squared  value  of  relative  veclocity 

X 

State  vector 

XAI 

Aircraft  inertial  position,  X1 

a 

XAT 

Aircraft  true  position,  X 

a 

XI 

Old  value  of  X{1) 

X2 

Old  value  of  X(2) 

XI 

Vector  including  XB1,  XB2,  velocity  of  sonobuoy,  and 
two  zeros  used  in  the  six-state  system 

X31 

True  geographical  location  of  sonobuoy,  x ^ 

X32 

True  geographical  location  of  sonobuoy,  *2 

XB1 1 

Array  of  initial  sonobuoy  positions 

X32I 

Array  of  initial  sonobuoy  positions 

XNEXT 

Propagated  value  of  X 

z 

Measurement  vector 
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ZHAT 

ZN 

ZU 


Estimate  of  z 

Normally  distributed  random  number  from 
Vector  of  velocity  measurement  for  drift 


V 
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1  V  X 
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APPENDIX  B 

COMPUTER  PROGRAM  FOR  DATA  GENERATION 


LINE 


Set: 

Phi  «  0 
Accel  -  0 


Calculate: 
aircraft  po$ition| 


Call 

FILE 


O 


Figure  37. 


DATA  GENERATION 


Flow  chart*  data  generation  program. 


GLOSSARY  OF  COMPUTER  VAR  1AELES 


A 

AL 

ALT 

ANT 

AVEL 

AX  1 

AX2 

3 

BANG 

RCUY 

BVEL 

CKL 

D 

CELT 

DELV1 

DELV2 

DELX1 

DELX2 

EH 

DSEED 

END 

>1 

GAMMA 


DATA  GENERATION  PROGRAM 

Vector  of  aircraft  accelerations 
Altitude  in  nautical  miles 
Altitude 
Antenna 

Initial  aircraft  velocity 
Amplitude  of  Schuler  cycle,  A 
Amplitude  of  Schuler  cycle,  A.xl 
Intercept  on  N-S  axis  of  straight  track 
Sonobuoy  drift  direction 
Sonobucy  RF  channel  or  number 
Sonobuoy  drift  direction 

Rate  of  change  of  nautical  miles  for  a  change  in 
degrees  of  longitude 

Length  of  straight  track 

Interval  between  measurements.  At 

Relative  velocity,  Avj 

Relative  velocity,  Av2 

Relative  position,  a*j 

Relative  position,  ax2 

Total  change  in  heading  while  on  curved  track 
Seed  for  the  random  number  generator 
Indicator  of  EOF 
Gravitational  acceleration 
Aircraft  pitch  angle,  y 
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GR  Gamma  in  radians 

H  Aircraft  heading 

HNS*  Final  heading  on  curved  track 

HOUR  Time  in  hours 

HR  Heading  in  radians 

IOUT  Device  on  which  print  is  made 

ICDT?  File  in  which  results  are  written 

IOUTR  File  in  which  true  sonobucy  positions  are  written 

IOUTZ  File  in  which  random  vectors  are  inspected 

I  TIME  Time  from  aircraft  clock  in  seconds 

XXI  Rate  of  linear  navigational  drift,  X 

XX  2  Rate  of  linear  navigational  drift,  X  „ 

x2 

DAT  Latitude 

DAT  I  The  latitude  of  the  origin  of  the  local  earth  fixed 
coordinate  system 

LONG  Longitude 

LONG  I  The  longitude  of  the  origin  of  the  local  earth  fixed 
coordinate  system 

LTIME  Array  of  initial  drop  times  for  the  sonobuoy 
M  Slope  of  straight  track 

MARX  Indicates  the  first  time  a  buoy  is  to  be  proccessed 
MIN  Time  in  minutes 

N  Index 

NEOUY  Total  number  of  sonotuoys 
NS TOP  End  of  line  or  curve  series 
PHI  Aircraft  roll  angle,  p 


129 


PR  Phi  in  radians 

R  Radius  of  curved  track 

RBI  Unit  vector  component  of  antenna  baseline 

R32  Unit  vector  component  of  antenna  baseline 

R33  Unit  vector  component  of  antenna  baseline 

S  Distance  aircraft  travels  in  time  At 

SEC  Time  in  seconds 

SKL  Rate  of  change  of  nautical  miles  for  a  change  in 

degrees  of  latitude 

TRACS  Direction  of  aircraft  travel  over  the  ground 

U  Direction  to  center  cf  curved  track 

7  Direction  from  center  of  curved  track  to  aircraft 

VA1  Velocity  of  aircraft 

VA2  Velocity  of  aircraft 

V31  Sonobuoy  drift 

VB2  Sonobucy  drift 

WAND  Wind  direction 

W V EL  Wind  velocity 

XAI  Aircraft  inertial  position,  X 

a 

XAT  Aircraft  true  position,  X 

a 

X31  True  geographical  location  of  sonobuoy,  x^ 

X52  True  geographical  location  of  sonobuoy,  x 

XCl  Location  of  the  center  of  the  curved  track 

XC2  Location  of  the  center  of  the  curved  track 

XXI  Incremental  change  in  X 

XX2  Incremental  change  in  X 

Z  Measurement  vector 
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RMS  P0SI  r  ION  ERROR  UOS1 


APPENDIX  C 
Range  Analysis 


FldTEP:  !SQRT  IP1+P 


ABOUT  ME:  AN  FljLTEP  POSITION 
R 8 d U T  ACTUAL  iPOSITIuN  1 


;|*(V^***,‘*8^ 


X  -  PBOU T  MEPN  FElTEP  pc 
CD  -  PBOu'"  PCTUPL  PjSIt;: 


TIME  'MINUTFSI 


Figure  38.  RMS  errors  for  two-state  system  (top)  and  six 
state  systan  (bottom)  using  circular  pattern  at  5  NM. 
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Figure  39-  RMS  errors  for  two-state  system  (top)  and  six- 
state  system  (bottom)  using  circular  pattern  at  30  NM. 


Figure  40.  RMS  errors  for  two-state  system  (top)  and  six 
state  system  (bottom)  using  circular  pattern  at  45  NM. 
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Frequency  Analysis 


TIME  (MINUTESI 


Figure  41.  RMS  errors  for  two-state  system  (top)  and  six 
state  system  (bottom)  using  square  pattern  with  t=4  sec. 
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time  'm’nutesi 


Figure  42.  RMS  errors  for  two-state  system  (top)  and  six- 
state  system  (bottom)  using  square  pattern  with  t=10  sec. 


HM5  PI1SIIU1N  IHHOh  HU'jl  HMb  PUSHKIN  1  HRDH  ITUSI 


2000. 


3.  2C.  >40.  SO.  80.  :C0.  120. 


T  [ ME  “INU^Sl 


Figure  43.  RMS  errors  for  two-state  system  (top)  and  six- 
state  system  (bottom)  using  square  pattern  with  t=30  sec. 
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Altitude  Analysis 


Figure  43.  RMS  errors  for  two-state  system  (top)  and  six- 
state  system  (bottom)  using  circular  pattern,  Alt=300'. 
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RMS  ROSMION  IMhllH  I1I1SI  HMS  RUSH  ION  LHH11H  (IUSI 


Figure  45.  RMS  errors  for  two-state  system  (top)  and  six- 
state  system  (bottom)  using  circular  pattern,  Alt=10,000'. 


147 


HMb  POSUIlIN  tHMlIH  1 1  lib  J  MMb  POSITION  t  HHOH  (TDbl 


BIBLIOGRAPHY 


Bryson,  Jr.,  A.  E.  and  Yu-Chi  Ho,  Applied  Optimal  Control, 
Hemisphere  Publishing  Corp.  1975* 

Carlson,  N.  A.,  Fast  Triangular  Formulation  of  the  Square  Root 
Filter,  Vol.  II,  No.  9.  AIAA  Journal,  September  1973* 

Demetry ,  J .  S . ,  Notes  on  the  Theory  and  Applications  of  Optimal 
Estimation,  Naval  Postgraduate  School,  Monterey,  California 
1970. 

Gelb,  A.  and  others,  Applied  Optimal  Estimation,  M.I.T.  Press 

197^. 

Leondes,  C.  T.  Editor,  Control  and  Dynamic  Systems,  Vol.  12, 
Academic  Press ,  1976 . 

Orincon  Corporation  Report  0C-R-78-A003-1  Sonobuoy  Reference 
System,  by  Asher,  R.  M.  ,  Judge,  R.,  and  Sorenson,  H.  W., 
December  1978. 

System  Functional  Description  for  Sonobuoy  Reference  System, 
FD-17  (I  4.3),  Naval  Air  Development  Center,- June  1978. 

System  Functional  Description  for  Navigation,  FD-9  (I  3/4.2) 
Naval  Air  Development  Center,  November  1977* 


INITIAL  DISTRIBUTION  LIST 


No.  Copies 

1.  Defense  Documentation  Center  2 

Cameron  Station 

Alexandria,  Virginia  22314 

2.  Library,  Code  0142  2 

Naval  Postgraduate  School 

Monterey,  California  93940 

3.  Department  Chairman,  Code  62  1 

Deoartment  of  Aeronautics 

Naval  Postgraduate  School 
Monterey,  California  93940 

4.  Prof.  D.  J.  Collins.  67Co  3 

Department  of  Aeronautics 

Naval  Postgraduate  School 
Monterey,  California  93940 

5.  LT  N.  M.  Brownsberger  2 

3802  La  Miranda  PI 

Pittsburg,  California  94565 

6.  Dr.  D.  Birnbaum,  Code  2031  1 

Naval  Air  Development  Center 

'♦'arminister ,  Pennsylvania  1SS?4 


4 


150 


